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(54) System for and method of equivalent circuit reference type control 

(57) In a technique of monitoring whether a physical 
system is normal or abnormal by continuously compar- 
ing a phenomenon taking place in the system and a 
phenomenon taking place in a model and also in a tech- 
nique of control adopting evaluation functions using an 
error quantity in the model, the phenomena in both the 
physical system and model can be optimized. An equiv- 
alent electric circuit to the physical system is produced, 
and an input is provided to both of the system and the 
circuit In this state, the output of the physical system 
and the reference value of the equivalent electric circuit 
are compared. The use of the equivalent electric circuit 
permits solving the problem inherent in the prior art that 
the time necessary for analog-to-digital conversion and 
numerical calculations is longer than the time of the 
actual phenomenon and disables real time simulation. 
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Description 

BACKGROUND OF THE INVENTION 
5 1 . Field of the Invention 

This invention relates to techniques of controlling physical systems as the subject of control, such as uniaxial 
robots, muftiaxial robots, crankshaft mechanisms, gear trains, acoustical transducers, acoustical filters, closed U-shape 
tubes, radiator fins. etc. and, more particularly, to techniques of controlling the output of a physical system through con- 
to trol of the input thereto. For example, the invention concerns the techniques of controlling the output of a uniaxial robot, 
such as the rotational position, rotational speed and rotational acceleration of a joint of the robot, through control of 
input current fed to a joint drive motor, controlling the stroke direction force of a crankshaft mechanism through momen- 
tum control, controlling the output sound pressure of an acoustical transducer through input sound pressure control, 
controlling the head level of a closed U-shape tube on one end side thereof through control of pressure applied to the 
is other end side, and controlling the distal end temperature of a radiator fin through root temperature control thereof. 

2. Description of the Prior Art 

Japanese Laid-Open Patent Publication No. 63-23693 discloses one type of the above techniques. The disclosed 
20 technique comprises the steps of analyzing the relation holding between the input to and the output from a physical sys- 
tem as the subject of control, completing a mathematical model of the physical system according to the analyzed rela- 
tion, carrying out computer simulation of ihe operation of the physical system concurrently and in parallel to the 
operation of the physical system by using the mathematical model, comparing the actual output of the physical system 
and the result of the simulation, and providing the display of abnormality when the compared data are not in accord. 
25 This technique permits detection of occurrence of abnormality of some or other type, thus permitting a fail-and-safe 
process. 

However, the computer simulation is carried out digitally and requires analog-to-digital conversion. In addition, the 
rate of sampling input values is determined in conformity to computer specifications and can not be indiscriminately 
increased. What is more, the simulation involves calculations which require operations of solving differential equations 

30 and/or equations concerning deviations. This process takes considerable time. Moreover, comparison of actual value 
and calculated value requires digital-to-analog conversion. Due to the requirement of the various times as noted above, 
frequently, a high speed actual phenomenon can not be followed up by the computer processing. In such a case, the 
fail-and-safe process is not executed. Particularly, a complicated behavior of a physical system necessitates a consid- 
erably long simulation time, thus making real time simulation difficult even at an actual phenomenon speed which is not 

35 so high. This problem can not be ignored when actually using a personal computer or like close-at-hand computer. 

Besides, it requires great deals of time and labor to establish a mathematical model and complete a simulation pro- 
gram. A further problem is that in computer simulation using a mathematical model, cases of erroneous simulation inev- 
itably result from program bugs or like causes. Therefore, highly reliable fail-and-safe processes can not always be 
ensured. 

40 

SUMMARY OF THE INVENTION 

An object of the invention is to solve the problem of the disability of following up an actual phenomenon due to long 
time involved in the simulation. 
45 Another object of the invention is to solve the problem of the low reliability of simulation. 

A further object of the invention is to solve the problem that too much time and labor are required for producing a 
simulation program. 

According to the invention, a control system is provided, which controls the output of a physical system as a subject 
of control through control of the input to the physical system. The control system, as schematically shown in FIG. 1 . 

a? comprises an input controller 1 0 for controlling an input 1 1 to the physical system 1 2 as the subject of control, an equiv- 
alent electric circuit 18 which is constructed to be equivalent to the physical system 12, output detecting means 15 for 
detecting the output 13 of the physical system 12 during the presence of the input 1 1 to the physical system 12, refer- 
ence value detecting means 17 for detecting a reference value of the equivalent electric circuit 18 during the presence 
of the input to the equivalent electric circuit 18. and comparator means 16 for comparing the detected value of the out- 

55 put detecting means 1 5 and the detected value of the reference value detecting means 1 7. 

To the equivalent electric circuit 18 is inputted the same value as inputted to the physical system 12. In the circuit 
18. no analog-to-digital conversion process is required. This means that there do not arise the prior art problems that 
restrictions of the time taken in the analog-to-digital conversion process and input sampling interval may cause time- 
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wise deviation of the input to the physical system 12 and the input in the computer simulation using a mathematical 
model. The present system does not ignore input value variations in a shorter period than a sampling interval. 

According to the invention, in the equivalent electric circuit 18, an equivalent phenomenon to that in the physical 
system 12 takes place concurrently and in parallel. This permits elimination of the prior art problem that simulation cal- 

5 culations lag behind the actual phenomenon. 

A further advantage of the invention is that the output of the physical system 12 is an analog value while the refer- 
ence value of the equivalent electric circuit 18 is also an analog value. That is, it is necessary only to compare these 
two analog values, and neither requires analog-to-digrtal or digital-to-analog conversion. 

It is a yet further advantage of the invention that the equivalent electric circuit 18 can be produced easily compared 

10 to the production of a mathematical mode! even when the behavior of the physical system 1 2 is complicated, thus per- 
mitting preclusion of the requirement of long time until completion of the mathematical model. 

According to the invention, a control method is also provided. As shown in FIG. 1 , the control method is carried out 
by executing a step 19 of measuring parameters of the physical system by measuring the input to and the output from 
the physical system a number of times, a step 20 of calculating electric parameters equivalent to the parameters meas- 

75 ured in the measuring step, and a step 21 of producing an equivalent electric circuit by using parts which are provided 
with the calculated electric parameters, executing actual control by inputting the input to the physical system also to the 
equivalent electric circuit, and executing a step 22 of continuously comparing the output of the physical system and the 
reference value of the equivalent electric circuit. The steps 19 to 21 are executed in preparation and the step 22 is exe- 
cuted during the actual control. 

20 In this method, the equivalent electric circuit 18 is produced in the steps 19 to 21, and in actual control, both the 
physical system 12 and equivalent electric circuit 18 are controlled concurrently and in parallel. The result of control is 
also continuously compared, so that it is possible to obtain real time detection of occurrence of control abnormality or 
the like. 

25 BRIEF DESCRIPTION OF THE DRAWINGS 

The above and other objects, features and advantages of the invention will become more apparent from the follow- 
ing detailed description of the preferred embodiments of the invention when the same is read with reference to the 
accompanying drawings, in which: 

30 

FIG. 1 is a view schematically illustrating the principles underlying the invention; 
FIG. 2 is a schematic representation of a first embodiment of the invention; 
FIG. 3 is a view showing an equivalent electric circuit of a second embodiment of the invention; 
FIGS. 4(A) and 4(B) are views showing a crankshaft mechanism and an equivalent electric circuit therefor, respec- 
35 tively; 

FIGS. 5(A) and 5(B) are views showing a gear train and an equivalent electric circuit therefor, respectively; 
FIGS. 6(A) and 6(B) are views showing an acoustical transducer and an equivalent electric circuit therefor, respec- 
tively; 

FIGS. 7(A) and 7(B) are views showing an acoustical filter and an equivalent electric circuit therefor, respectively; 
40 FIGS. 8(A) and 8(B) are views showing a closed U-shape tube and an equivalent electric circuit therefor, respec- 
tively; and 

FIGS. 9(A) and 9(B) are views showing a radiator fin and an equivalent electric circuit therefor, respectively. 
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

45 

FIG. 2 shows a first embodiment of the invention as applied to a two-axial robot 39. The robot 39 has a base 45 
which rotatably supports a first arm 44 around a first axis 48. The rotation angle q 1 of the first arm 44 is adjusted by a 
first motor 40. The first arm 44 has a free end which rotatably supports a second arm 46 around a second axis 50. The 
rotation angle q 2 of the second arm 46 is adjusted by a second motor 42. The first and second motors 40 and 42 

so respectively generate torques i<\ and which are proportional to input currents I-, and (t 1 = k 1 • l t , x 2 = k 2 • l 2 ). 
The input currents ^ and are controlled by a two-axial controller 30. The two-axial controller 30 controls the input cur- 
rents l n and l 2 with the lapse of time according to a working program for the robot 39. The robot 39 thus executes such 
operation as revolution at a low speed, revolution at a high speed or revolution in the reverse direction according to the 
working program. The two-axial controller 30 comprises a digital computer having a built-in interface and can control 

55 analog values of the input currents If and l 2 . 

A tachometer generator 36 is provided in the first motor 40, and another tachometer generator 38 is provided in the 
second motor 42. These tachometer generators 36 and 38 provide outputs 80 and 82 which are proportional in value 
to the angular speeds of rotation. More specifically, the tachometer generator 36 outputs an analog value which is pro- 
portional to the revolution speed of the first arm 44, while the tachometer generator 38 outputs an analog value propor- 
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tional to the revolution speed of the second arm 46. These analog values proportional to the revolution speeds are 
inputted to one input terminal of respective operational amplifiers 70 and 74. 

The input currents l t and f 2 which are controlled by the two-axial controller 30 are also inputted to an equivalent 
electric circuit 52. The equivalent electric circuit 52 includes a pair of resistors 54 and 56. A voltage k-, • I, proportional 

s to the input current l 1 is generated across the resistor 54. while a voltage • l 2 proportional to the input current is 
generated across the resistor 56. The resistor 54 forms a first closed loop 67 together with a resistor 62 and a coil 58 
connected thereto. The resistor 56 forms a second closed loop 69 together with a resistor 64 and a coil 60 connected 
thereto. The mutual inductance between the coils 58 and 60 is M. 

The first closed loop 67 has a first current detector 66 which outputs an analog value 84 proportional to a current 

10 i 1 in the first loop 67. The second closed loop 69 has a second current detector 68 which outputs an analog value 86 
proportional to a current i 2 in the second closed loop 69. The value 84 proportional to the current h in the first closed 
loop 67 is inputted to the other input terminal of the operational amplifier 70. Likewise, the value 86 proportional to the 
current in the second closed loop 69 is inputted to the other input terminal of the operational amplifier 74. The oper- 
ational amplifier 70 compares the analog value 80 proportional to the revolution speed of the first arm 44 and the analog 

is value 84 proportional to the current i 1 in the first closed loop 67, and operates an alarm 72 when the difference between 
the compared values exceeds a predetermined value. The operational amplifier 74 compares the analog value 82 pro- 
portional to the revolution speed of the second arm 46 and the analog value 86 proportional to the current i 2 in the sec- 
ond closed loop 69, and operates an alarm 76 when the difference between the compared values exceeds a 
predetermined value. The alarms 72 and 76 are connected to the two-axial controller 30 which stops the operation of 

20 the robot 39 when at least either of the alarms 72 and 76 is operated. As an alternative of stopping the robot 39, it is 
possible to cause the operational amplifiers 70 and 74 to detect differences and correct the input currents ^ and l 2 by 
the detected differences. 

Denoting the mass of the first arm 44 by m 1f the distance between the certtroid of the first arm 44 and the first axis 
48 by ^ , the mass of the second arm 46 by rr^, the distance between the centroid of the second arm 46 and the second 

25 axis 50 by r 2 , the distance between the first and the second axes 48 and 50 by ^ , the moment of inertia of the first arm 
44 by h , the moment of inertia of the second arm 46 by l 2 . the friction coefficient around the first axis 48 by . and the 
friction coefficient around the second axis 50 by d 2 , the equation (1) in FIG. 2 concerning the torque k 1 • \ % applied by 
the first motor 40 is satisfied, and the equation (4) concerning the torque k 2 • ^ applied by the second motor 42 is sat- 
isfied. The equations (1) and (4) are approximate functions which are obtained by removing non-linear term from 

30 Lagrangean function. 

Denoting the resistance of the resistor 62 by R t , the inductance of the coil 58 by ^ , the resistance of the resistor 
64 by F^. the inductance of the coil 60 by Lg, the mutual inductance between the coils 58 and 60 by M, the equation (2) 
concerning the first closed loop 67 is satisfied, and the equation (3) concerning the second closed loop 69 is satisfied. 

As is obvious from the form of the equations (1), (2), (3) and (4), perfect proportionality Of the revolution speeds 
35 (i.e., single differentials of the rotation angles and cfc) and the currents i n and to one another can be obtained by 
setting the values of the inductances L 1§ L 2 and M and resistances R t and to be proportional to the coefficients in 
the equations (1) and (4). In other words, it is obvious that the behavior of the multiaxial robot 39 as expressed by the 
equations (1) and (4) and the electrical behavior of the equivalent electric circuit 52 are physically equivalent to each 
other. 

40 In this embodiment, the angle, speed and acceleration of revolution of the multiaxial robot 39 are preliminarily 
measured by giving various values of the input currents h and to the robot 39. The coefficients in the equations (1) 
and (4) are obtained from the values of the input current and the output at this time by the least square method. Electric 
* parameters of the coils 58 and 60, resistors 62 and 64, etc. are selected from the coefficients obtained in this way. In 
this case, the analog values 80 and 84 inputted to the operational amplifier 70 are set to be equal to each other, and 

45 also the analog values 82 and 86 inputted to the operational amplifier 74 are set to be equal to each other. It is possible 
to provide separate operational amplifiers for analog value adjustment, ft is well recognized in the art that the behavior 
occurring in a mechanical system and that occurring in an electric system can be made equivalent to each other. 

In the preparation stage, the coefficients (or parameters) in the equations (1) and (4) which describe the motion of 
the physical system are measured, and the equivalent electric circuit 52 for bringing about an equivalent electric phe- 

50 nomenon is produced. That is, a system shown in the upper half of FIG. 2 is preliminarily built up. 

In the actual control, the input currents l 1 and l 2 are continuously inputted to the equivalent electric circuit 52. Dur- 
ing this time, the tachometer generators 36 and 38 continuously detect outputs from the physical system (i.e. revolution 
speeds) while current detectors 66 and 68 continuously detect reference values (i.e., currents in this case) in the equiv- 
alent electric circuit 52. Each of the operational amplifiers 70 and 74 continuously detects the two values inputted 

55 thereto. 

When no abnormality is produced in the control system, an equivalent phenomenon to that in the physical system 
is produced in the equivalent electric circuit 52. the two analog values inputted to each of the operational amplifiers 70 
and 74 are equal, and neither of the alarms 72 and 76 is operated. When some abnormality occurs, for instance when 
an obstacle collides with the robot 39 to prevent the scheduled operation, the behavior in the physical system and that 



4 



3 0007*31 398 fhttp:/A<vww.getthepatent.com/Login.doq/Ssandy.robb1/Fetch/EP000731 398.cpc?fromCache=1 part=maintoolbar=bottom1 Page 5 of 13 



EP0 731 398 A2 

in the equivalent electric circuit 52 fails to be in accord with each other. For example, when the movement of the first 
arm 44 is unexpectedly restricted, the revolution speed of the first arm 44 and the current in the first closed loop 67 are 
no longer proportional- This results in failure of accord of the levels of the inputs to the first operational amplifier 70, thus 
causing the alarm 72 to operate. Likewise, when the movement of the second arm 46 is unexpectedly restricted, the 

5 revolution speed of the second arm 46 and the current in the second closed loop 69 are no longer proportional, so that 
the levels of the inputs to the second operational amplifier 74 fails to be in accord, thus causing the alarm 76 to operate. 

In this embodiment, as described above, in the actual control, the same input data is given to the physical system 
and also to the equivalent electric circuit 52 to cause equivalent phenomena concurrently and in parallel. It is thus pos- 
sible to real time monitor for any abnormality or monitor the operation as scheduled. 

io In FIG. 2, the phenomena taking place outside the two-axial controller 30 all utilize analog values, and the process 
of monitoring does not require any analog-to-digital or digital-to-analog conversion. The equivalent electric circuit 52 is 
an analog circuit, and in this circuit, a behavior equivalent to that in the robot 39 is obtained concurrently and in parallel. 
In other words, in this embodiment, the concurrence of equivalent phenomena is maintained. Furthermore, in a prior art 
mathematical model simulation technique, quick change of the input currents \ A and l 2 is ignored when the change of 

15 the input currents is rapid compared with the sampling rate. In this embodiment the equivalent electric circuit 52 main- 
tains equivalent behavior to that of the robot 39 even if the input currents I-, and l 2 change quickly. 

As described above, the equations (1) and (4) are approximate functions free from non-linear term. The circuit 
shown in FIG. 2 shows an approximate equivalent electric circuit in this case, whereas shown in FIG. 3 is an equivalent 
electric circuit in which non-linear terms as well are taken into consideration. Using coefficients in the equations (5) to 

20 (7) among the equations (5) to (1 3) shown below, the motion around the first axis is given by the equation (8), and the 
motion around the second axis is given by the equation (9). These equations (8) and (9) of motion contain non-linear 
terms and refiect influence of Coriolis 5 force, centrifugal force and posture changes of the robot 39. The equation (10) 
is a transformation of the equation (8), and the equation (13) is a transformation of the equation (9). The equations (1 1) 
and (12) are satisfied with the electric circuit shown in FIG. 3, that is. an electric circuit in which the first loop has electric 

25 parameters of the self inductance L 3 , mutual inductance M 2 and resistance R3 and the second loop has parameters of 
the self inductance L^, mutual inductance M 2 and resistance R 4 . 

Ci =l i + U +m i r i 2+n, 2 l 1 2+m 2 r 2 2 (5) 

30 ^2 =, 2 +m 2 r 2 P>) 

C 3 «m 2 l 1 r 2 (7) 

t t =(C t +2C 3 cosq 2 ) q t +(C 2 +C 3 cosq 2 ) q 2 +(d 1 -2C 3 q 2 sinq 2 ) q 1 -(C 3 sinq 2 ) q \ (8) 

35 

^2=( C 2)^2+( C 2 +C 3«^2)Pl+( d 2)q2^ C 3® n q2)Ql ( 9 ) 

k^t+fCaSinq^q^ ^C^^cosq^q^C^^ (10) 
40 V 1 =L 3 i 1 +M 2 i 2 +R 3 i 1 (11) 

V 2 =L 4 i 2 +M 2 i 1+ R 4 i 2 (12) 
k 2 l 2 -(C 3 sinq 2 )qi =C 2 q 2 ^C 2 -^ 3 cosq 2 )q 1 -Kl 2 i 2 (13) 

45 

As is obvious, assuming that the coefficients in the equations of motion of the robot are proportional to the coeffi- 
cients in the electric circuit, the mechanical behavior taking place in the robot and the electrical phenomenon in the 
electric circuit are equivalent to each other. In this case, the speed of revolution around the first axis and the current i t 
in the first loop are equivalent, and the speed of revolution around the second axis and the current i 2 in the second loop 
so are equivalent! 

In the consideration of the non-linear terms as well, the electric parameters of one of the loops must be varied 
according to the current in the other loop. To meet this requirement, a reactance transistor is used for the resistor 102 
and the coil 104 in the first loop. A reactance transistor is also used for the coil 106 for the mutual inductance. These 
reactance transistors have properties that their resistance and inductance are varied according to the inputted current 
55 They permit production of an electric circuit the behavior of which is equivalent to that expressed by the equations (10) 
and (13). by setting the inputted currents as shown in FIG. 3. 

Current-to-voltage transducers 108 and 110 in FIG. 3 control the voltages applied to the first and second loops 
according to the inputted currents. Current signals for electric parameter control are controlled in the FIG. 3 circuit A 
current detector 112 detects the current in the second loop (which is equivalent to the single differential of q^. An 
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integrator 1 14 integrates the output of the current detector 112. The output of the integrator 1 14 is inputted to the reac- 
tance transistors, so that inductances of the coils 104 and 106 are controlled according to the cosine of the integral of 
the current in the quadratic circuit The elements shown as "SQUARE" each output a current corresponding to the 
square of the input. The elements shown as "MULTIPLY" each multiply two input currents by each other and output the 
5 product The element shown as "sin" outputs the sine of the input Thus, the coefficients in the equations (10) and (11) 
can be made proportional to one another, and the coefficients in the equations (12) and (13) can be made proportional 
to one another. This means that with the FIG. 3 circuit, it is possible to make the robot and the electric circuit to be equiv- 
alent to each other. 

It is thus possible to make the current i 1 in the first loop and the speed of revolution around the first axis to be equiv- 

10 aient to each other and also make the current i 2 in the second loop and the speed of revolution around the second axis 
to be equivalent to each other. By comparing these data by the FIG. 2 operational amplifiers 70 and 74, it is possible to 
obtain monitoring as to whether the equivalent phenomena are taking place as scheduled or some abnormality is taking 
place. The FIG. 3 equivalent electric circuit permits closer approximation than the FIG. 2 equivalent electric circuit 
However, as a result of various experiments conducted by the inventor, it was confirmed that the FIG. 2 approxi- 

15 mate equivalent circuit, i.e., the circuit 52 which is free from any non-linear term, can produce phenomena which may 
actually be made equivalent, and that a monitoring process as to whether any abnormality is taking place is possible 
with an arrangement that the alarms 72 and 76 are not operated when the differences inputted to the operational ampli- 
fiers 70 and 74, respectively, are in predetermined ranges. 

FIGS. 4(A) and 4(B) show a crank mechanism and an equivalent electric circuit therefor, respectively. In this case, 

20 by making the voltage applied to the first closed loop 1 02 to be proportional to the moment M A of the crankshaft making 
the voltage applied to the second closed loop 1 04 to be proportional to stroke force F 2 and making electric parameters 
of the first and second closed loops 102 and 104 to correspond to mechanical parameters of the crank shaft mecha- 
nism, relations can be obtained that the speed or revolution about the crankshaft is equivalent to the current in the first 
closed loop 1 02 and that the stroke speed is equivalent to the current in the second closed loop 104. Again in this case, 

25 like the FIG. 2 case, it is posstole to obtain monitoring as to whether the crankshaft mechanism is normal or abnormal. 
FIGS. 5(A) and 5(B) show a gear train and an equivalent electric circuit therefor, respectively. In this case, by mak- 
ing the voltage applied to the first closed loop 106 to be proportional to the moment of a first gear 110. making the volt- 
age applied to the second closed loop 108 to be proportional to the moment of a second gear 112 and making electric 
parameters of the first and second closed loops 1 06 and 1 08 to correspond to mechanical parameters of the gear train, 

30 the speed of revolution of the first gear 1 1 0 is made equivalent to the current in the first closed loop 1 06, and the speed 
of revolution of the second gear 1 1 2 is made equivalent to the current in the second closed loop 1 08. Again in this case, 
like the FIG. 2 case, it is possible to obtain monitoring as to whether the gear train is normal or abnormal. 

FIGS. 6(A) and 6(B) show an acoustical transducer comprising a large dameter cylinder and a small diameter cyl- 
inder and an equivalent electric circuit therefor, respectively. In this case, by setting mechanical parameters of the phys- 

35 ical system (i.e. . acoustical transducer) to circuit parameters of the equivalent electric circuit and applying a voltage 
proportional to the sound pressure q 1 at the large diameter cylinder inlet between terminals A and B, the sound pres- 
sure qz at the small diameter cylinder outlet can be made equivalent to the voltage between terminals C and D. Again 
in this case, the phenomenon in the physical system and that in the equivalent electric circuit can be made equivalent. 
Thus, like the FIG. 2 case, by comparing the two phenomena, it is possible to obtain monitoring as to whether the 

40 acoustical transducer is normal or abnormal. 

FIGS. 7(A) and 7(B) show an acoustical filter and an equivalent electric circuit therefor, respectively. In this case, 
by applying a voltage proportional to input sound pressure between terminals E and F, a voltage proportional to an 
output sound pressure P 2 is generated between terminals G and H. 

FIGS. 8(A) and 8(B) show a closed U-shape tube and an equivalent electric circuit therefor, respectively. In this 

45 case, by applying a voltage proportional to a pressure P applied to one end of the tube between terminals I and J, a 
current proportional to the head level at the other end of the tube is caused to flow in the circuit. 

FIGS. 9(A) and 9(B) show a radiator fin and an equivalent circuit therefor, respectively. In this case, by applying a 
voltage proportional to the root temperature T 1 of the fin. a voltage proportional to the distal end temperature T 2 of the 
fin is generated between terminals M and N. 

so The above examples of the physical system and equivalent electric circuit therefor were introduced in literatures. 

According to the invention, equivalent phenomena are produced concurrently in a physical system and an equiva- 
lent electric circuit therefor, and it is possible to obtain comparison as to whether the equivalence is maintained, thus 
permitting real time monitoring of whether or not any abnormality is taking place in the physical system Besides, it is 
possible to eliminate time taken in the analog-to-digital conversion, sampling and numerical calculation that are neces- 

55 sary for simulation with a mathematical model, thus eliminating the possibilities of lagging of the simulation behind the 
actual phenomena and the simulation with input of a different value. According to the invention, it is thus possible to 
obtain real time monitoring of the behavior of complicated physical systems. Besides, the production of an equivalent 
electric circuit has a merit that it requires a short time compared to the development of a program of simulation using a 
mathematical model. Moreover, the reliability can be improved. 
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While some preferred embodiments of the invention have been described in the foregoing, it is to be understood 
that changes and modifications may be made in the details of the design without departing from the scope and spirit of 
the invention as defined in the appended claims. 

In a technique of monitoring whether a physical system is normal or abnormal by continuously comparing a phe- 

5 nomenon taking place in the system and a phenomenon taking place in a model and also in a technique of control 
adopting evaluation functions using an error quantity in the model, the phenomena in both the physical system and 
model can be optimized. An equivalent electric circuit to the physical system is produced, and an input is provided to 
both of the system and the circuit In this state, the output of the physical system and the reference value of the equiv- 
alent electric circuit are compared. The use of the equivalent electric circuit permits solving the problem inherent in the 

10 prior art that the time necessary for analog-to-digital conversion and numerical calculations is longer than the time of 
the actual phenomenon and disables real time simulation. 

Claims 

is 1. A system for equivalent circuit reference type control of the output of a physical system as a subject of control 
through control of the input to the physical system comprising: 

an input controller for controlling the input to the physical system; 
an equivalent electric circuit equivalent to the physical system; 
20 output detecting means for detecting the output of the physical system while the input to the physical system 

prevails; 

reference value detecting means for detecting a reference value of the equivalent electric circuit while the input 
to the equivalent electric circuit prevails; and 

comparator means for comparing the detected value of the output detecting means and the detected value of 
25 the reference value detecting means. 

2. A method of equivalent circuit reference type control of the output of a physical system as a subject of control 
through control of the input to the physical system, comprising: 

30 executing, in a preliminary stage, a step of measuring parameters of the physical system by measuring the 

input to and the output from the physical system a number of times, a step of calculating electric parameters 
equivalent to the parameters measured in the parameter measuring step, and a step of producing an equiva- 
lent electric circuit by using parts with the calculated electric parameters; and 

executing, in the actual control, a step of inputting the input to the physical system also to the equivalent elec- 
35 trie circuit to continuously compare, in this state, the output of the physical system and the reference value of 

the equivalent electric circuit. 

3. A system for control of a two-axial robot having a base, a first arm mounted on and rotatable relative to the base, a 
second arm mounted on the free end of and rotatable relative to the first arm. a first motor for rotating the first arm, 

40 and a second motor for rotating the second arm, the system comprising: 

a first closed loop (67) including a resistor (54) having a grounded terminal, a current proportional to the current 
(Ij) in the first motor being passed through the resistor (54), and a series connection of a resistor (62) and a 
coil (58), the series connection being connected between the opposite terminals of the resistor (54), 

45 a second closed loop (69) including a resistor (56) having a grounded terminal, a current proportional to the 

current (fe) in the second motor being passed through the resistor (56), and a series connection of a resistor 
(64) and a coil (60), the series connection being connected between the opposite terminals of the resistor (56); 
a first current detector (66) for detecting the current in the first closed loop (67); 
a second current detector (68) for detecting the current in the second closed loop (69); 

so a first tachometer generator (36) for outputting an analog value proportional to the speed of revolution of the 

first arm; 

a second tachometer generator (38) for outputting an analog value proportional to the speed of revolution of 
the second arm; 

a first comparator (70) for comparing the output of the first current detector (66) and the output of the first 
55 tachometer generator (36); and 

a second comparator (74) for comparing the output of the second current detector (68) and the output of the 
second tachometer generator (38); 
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wherein the resistance R 1 of the resistor (62), the inductance L 1 of the coil (58), the resistance R2 of the 
resistor (64), the inductance L 2 of the coil (60) and the mutual inductance M between the coils (58) and (60) are 
given as 

5 R 1 =d 1f 

L 1 =l 1 + l 2 + m 1 r 1 2 +m 2 / 1 2 + m 2 r2 2 . 
R 2 =d 2 , 

10 

2 

L 2 = l 2 + m 2 r 2 , and 
2 

Ml = 1 2 + m 2 x 2 » 

15 where dj is a friction coefficient of the first arm, cfe is a friction coefficient of the second arm, l t is the moment of 
inertia of the first arm, l 2 is the moment of inertia of the second arm, m 1 is the mass of the first arm, rrfe is the mass 
of the second arm, is the distance between the center of rotation of the first arm and the center of rotation of the 
second arm, x^ is the distance between the center of rotation of the first arm and the centroid thereof, and r 2 is the 
distance between the center of rotation of the second arm and the centroid thereof. 

20 
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